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Description 

Field of the Invention 

5 The present invention relates to methods of and apparatus tor, determining the location of an object and in partic- 

ular, but not exclusively to methods and apparatus which employ a magnetic field which is sensed at the object. 

Background of the Invention 

io it has been long appreciated that if the magnetic field around a field generating element, for example a generatirig 

coil, can be accurately mapped then it might be possible to determine the location of a field sensor, for example a 
sensing coil, relative to the generating coil, from the signals sensed by such a sensing coil. However, a problem as- 
sociated with doing this is that there are in general many locations and/or orientations of the sensing coil within the 
field of the generating coil that will provide the same characteristic sensing signals in the sensing coil. In order to use 

is a magnetic field for this purpose, additional information must therefore be provided. 

Prior art approaches to providing the additional information required comprise either moving the generating and 
sensing coils relative to each other, or scanning the axis of the generated field past the sensing coil. 

An example of the first approach is taught in US 3,644,825 wherein a system is disclosed for locating the position 
of a field sensor, comprising two orthogonal sensing coils, relative to a field generating element which relies on having 

20 knowledge of the direction of motion of the sensor relative to the generator. It should be noted that this system cannot 
detect the location of an object unless there is such relative motion, and its direction is known. 

The second approach of scanning the axis of the generated field is disclosed, for position location in two dimen- 
sions, in US 3,121,228 and for position location in three dimensions in US 3,868,565. 

US 3,121,228 describes how the distance and direction of a sensor, again comprising two orthogonal sensing 

£5 coils, relative to a field generator, also comprising two orthogonal coils, can be determined. The two orthogonal gen- 
erating coils are driven in phase quadrature so that the axis of the resultant field is caused to rotate within a plane. If 
the sensor is located within this plane then the axis of the field is guaranteed to scan past the sensor, and, because 
at any given distance from a field generator the field strength will be a maximum at the field axis, the sensor will detect 
a maximum in field strength at this time. The voltage induced in any one of the two coils forming the sensor will be 

30 dependent on the orientation of the coil relative to the field generator, and it is for this reason that in '228 two orthogonal 
coils are utilised in the sensor. The sum of these two voltages gives an indication of the distance between the sensor 
and generator, while the phase difference between the two voltages gives an indication of the direction of the generator 
relative to the sensor. It is thus essential to the operation of the location system of '228 that the axis of the field rotates 
and that two coils are present in the sensor. 

35 In US 3, 868, 555 this approach of scanning the axis, or maximum intensity vector, of the field past the sensor is 

extended to allow location of the sensor in three dimensions. Whereas in two dimensions it is sufficient merely to rotate 
the axis of the field within the plane to be sensed to guarantee it passing through the sensor, jn three dimensions- the 
axis would have to be rotated so that it described the surface of a sphere in order to be certain it encountered the 
sensor. To ensure that the axis passed through all points on the surface of a sphere the motion of the axis would be 

40 such that it encountered the sensor only very infrequently, and thus measurements by the sensor of the maximum field 
strength would also be infrequent. To avoid this the location system of '565 drives the generator coils in a complex 
fashion so that the field axis tracks and rotates around the position of the sensor. 

in order to locate the position of the sensor in three dimensions, according to the method of '565, three mutually 
orthogonal generating coils and three mutually orthogonal sensing coils are required and the three generating coils 

45 must be driven simultaneously by the three drive currents having amplitude and phase relationships between them 
which are controlled so as to direct the field axis towards the sensor. 

The approach taken in '565 further requires that the various equations governing the voltage induced in a sensing 
coil located and orientated in a particular alternating magnetic field are solved dynamically in real time i.e. during the 
acquisition of data from the sensing coil. This requirement, in addition to limiting the speed at which the sensor can 

so move while still being located successfully by the system, also means that should it be desired to locate more than 
one sensor, all apparatus will need to be duplicated for each additional sensor. 

US 4,710,708 discloses a position location system, in which it is not necessary to scan the field axis. '708 employs 
multiple coil field generators and a single coil sensor, but utilises standard iterative algorithms to solve for all the var- 
iables of the relevant simultaneous equations, in a computationally intensive manner. 

55 

Summary of the Invention 

According to a first aspect of the present invention there is provided a method of determining the location and/or 
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orientation of a field sensor relative to a plurality of field generators of known location, each field generator comprising 
a plurality of collocated field generating elements, each generating element being energized and a measurement being 
made at the field sensor of the respective field generated by the generating element, the method being characterised 
by the steps of: 

s 

1) for each field generator calculating, from the measurements of the field generated by each of its generating 
elements and an estimate of the orientation of the sensor, an estimate of the distance from that particular field 
generator to the sensor, and 

2) utilising the estimates of distance from step 1), and the known location of the field generators to calculate an 
10 estimate of the location of the sensor; 

3) employing the estimated location of the sensor from step 2) and the measurements of the field at the sensor to 
calculate a new estimate of the orientation of the sensor; 

4) repeating steps 1) to 3) iteratively, with step 1) employing the new estimate of sensor orientation from the 
preceding step 3), to improve the estimates of location and orientation of the sensor 

15 

The method of the first aspect of the present invention thus enables the location and orientation of a sensor to be 
determined without either relative motion between the sensor and the field generating element, or scanning of the axis 
of the field. 

Furthermore, by calculating an estimate of the distance of the sensor from each field generator, a surprisingly 
20 accurate estimate of the position of the sensor is achieved in a computationally simple manner. 

Since the method dissociates the stages of acquisition of data from the sensor, and processing of that data, rapid 
determination of the sensor location is facilitated. Furthermore the location of additional sensors may be determined 
simply by simultaneous measuring the field, generated by each generating element, at these other sensors and inde- 
pendently calculating their distances from the field generators. It should be noted that no modification of the field 
25 generating apparatus or method of driving the apparatus is required in order to determine the location of a plurality of 
sensors. 

The applicants have discovered that advantageously the method of the first aspect of the present invention also 
allows the location of a sensor comprising a single sensing element, for example a sensing coil, to be determined, as 
will be explained subsequently. This is particularly advantageous for positioning applications in which two or more 
30 mutually orthogonal sensing coils, as required by prior art techniques, cannot be used. 

According to a second aspect of the present invention there is provided a method of determining the location of a 
field sensor, comprising a plurality of collocated field sensing elements, relative to a field generator, comprising a 
plurality of collocated field generating elements, each field generating element being energized in turn and the value 
of the resultant field strength being measured at the field sensor, the measured field strength being dependent on the 
35 location of the sensor within the respective field, the method being characterised by the steps of: 

1) calculating, by utilising ail the values of measured field strength and an estimate of the direction of the sensor 
from the field generator, a direction dependent weighting factor for each field generating element so that the cal- 
culated field strength B is equal to the field strength B that would exist at the sensor if the axis of the field were 

40 directed towards the sensor, 

2) iteratively altering the direction dependent weighting factors to maximise B and thus to determine to a desired 
level of accuracy the direction of the sensor from the field generator, and 

3) employing the measured values of the field strength to calculate the distance of the sensor from the field gen- 
erator and hence, from the direction of the sensor in step 2), the location of the sensor relative to the field generator. 

This aspect of the invention thus provides a method of locating a sensor relative to a single field generator. 
The invention further provides apparatus suitable for carrying out the methods of the first two aspects of the in- 
vention. 

Preferred embodiments of the present invention will now be described, by way of example only, with reference to 
so the accompanying figures in which: 

Figure 1 shows a first embodiment of the invention, 

Figure 2 shows the cartesian coordinate system employed for a sensor of arbitrary orientation located at point R 
Figure 3 shows schematically the resolution of the magnetic flux density at a sensor, 
ss Figure 4 shows the coordinate system employed to locate a sensor relative to a field generator, 

Figure 5 shows schematically a simulated circle of constant induced voltage, in a sensor, in two dimensions, which 
is employed in the first embodiment of the invention, 

Figure 6 shows schematically three simulated spheres of constant induced voltage each centred on a field gen- 
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erator, which is employed in the first embodiment of the invention, 

Figure 7 shows a flow chart of a first positioning algorithm used in the first embodiment of the invention, 
Figure 8 shows the same schematic as Figure 6 when the location and orientation of the sensor have been deter- 
mined, 

s Figures 9, 10 and 11 schematically show a coordinate system employed in a second positioning algorithm used 

in the first embodiment of the invention, 

Figure 12 shows images of an endoscope obtained using the positioning system of the present invention on the 
left, and images obtained conventionally using X-rays on the right, (a) shows a sigmoid loop, (b) shows an alpha 
loop, and (c) shows a reverse alpha loop, 
'0 Figure 1 3 shows images of an endoscope within a patient obtained using the present positioning system on the 

left, and obtained using conventional X-ray imaging on the right, (a) shows an anterior view, and (b) shows a lateral 
view. 

Figure 1 4 shows a second embodiment of the invention. 

J5. In a first embodiment the invention enables a sensor comprising a single sensing coil to be located in three dimen- 

sions relative to a plane defined by three field generators. 

Detailed Description of the Drawings 

20 With reference to Figure 1 , three field generators 1 are mounted at known locations on a plane surface 2. Each 

field generator 1 comprises three electrically separate coils of wire (generating coils) 3 wound about a cuboid wooden 
former 4, which is approximately 40mm along one side. The three coils of each field generator are wound so that the 
axes of the coils are mutually perpendicular. The nine generating coils are separately electrically connected to an 
amplifier 5 which is able, under the direction of a controller 6, to drive each of the coils individually Each coil comprises 

2S 40 turns of 0.45mm copper wire and has an inductance of approximately 75mH. 

The sensor 7 comprises a single sensing coil of 200 turns of 42swg wire on a ferrite core of diameter 0.8mm, and 
length 12mm. Larger sensor coils will in general be more sensitive to the electro-magnetic fields generated by the 
generating coils, however the size of the coil is normally governed by the particular position location problem which is 
being addressed and frequently small sensor coils will be required. For an air-cored coil the sensitivity of the sensor 

so depends on the area of the coil, however the sensitivity can be increased by utilising a high magnetic permeability 
material in the core, and in this case the sensitivity will depend more strongly on the length of the coil than on its 
diameter. The sensing coil is electrically connected to a measurement unit 8 which in turn is connected to the controller 
6. The measurement unit 8 comprises an analogue to digital converter, and a matched filter (not shown). 

In use, the controller 6 directs the amplifier 5 to drive each of the nine generating coils 3 sequentially. The amplifier 

35 5 outputs a 10kHz drive signal of 3amps rrris which causes the particular generating coil being driven to generate a 
quasi-static magnetic field. The frequency of the drive signal is chosen so that, within the range over which the location 
of the sensor is to be determined, the field generated is a near-field electro-magnetic field i.e the wavelength is long 
compared to the distance from the generating coil to the sensing coil. 

Furthermore the drive signal frequency must be chosen so as to provide a compromise between sensor coil sen- 

40 sitivity, and the detrimental effects of electro-magnetic noise due to induced eddy currents within electrically conductive 
objects within the positioning range, since both of these aspects increase with frequency In the absence of electrically 
conducting objects a frequency of several hundred kilohertz may be used giving good sensor sensitivity and thus good 
range and positioning accuracy. In the presence of highly conductive objects, this frequency may need to be reduced 
to a few hertz. In this case a sensor coil may no longer be appropriate and may be replaced by an alternative magnetic 

45 field sensor, such as a flux gate magnetometer. In this embodiment a drive frequency of 10 kHz has been found to be 
a suitable compromise between sensitivity and immunity to interference from electrically conductive objects. 

Once the quasi-static field from a particular generating coil 3 is established, the value of the voltage induced in 
the sensing coil 7 by this field is measured by the measurement unit 8. The signal from the sensing coil 7 is first amplified 
and then sampled at 40 kHz by a 16 bit analogue-to-digital converter. The sampled signal is windowed using a Black- 

50 man-Harris window, the 1 0 kHz component is extracted by the matched fitter and hence a value representing the 
voltage induced in the sensing coil 7 is established. This value is passed to the controller 6 which stores the value and 
then instructs the amplifier 5 to stop driving the present generating coil 3 and to start driving the next generating coil 
3. When all nine generating coils 3 have been driven, or energised, and the corresponding nine voltages induced in 
the sensing coil 7 have been measured and stored, the controller 6 calculates the location and orientation of the sensor 

55 7 relative to the field generators 1 and displays this on a display device 9. This calculation can be carried out while the 
subsequent set of nine measurements are being taken. Thus, by sequentially driving each of nine generating coils 3, 
arranged in three groups of three mutually orthogonal coils, the location and orientation of a single sensing coil 7 can 
be determined. 
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In order to describe the algorithm employed by the controller 6 to calculate the location and orientation of the 
sensor 7, a coordinate system will first be defined. In Figure 2 is shown a sensor, located at position R whose axis is 
orientated along direction S. In general in order to determine the location and orientation of a single sensing coil within 
a field the x, y, z cartesian coordinates of the sensor and the elevation angle 9, and rotational angle <|>, must be found 
5 (see Figure 2). The vector distance R of the sensor from the origin, O, of the coordinate system is also shown in Figure 
2. Both the location and orientation of the sensing coil within the field will affect the voltage induced in the coil by the 
field, but rotation of the coil about its axis will not affect the induced voltage and thus does not constitute a further 
unknown quantity. 

Assuming now that a single field generating coil 3 is placed at the origin O of the coordinate system with its axis 
io directed along the z-axis. When the generating coil is energised a field will be produced at the sensor location P which 
has a magnetic flux density B. With reference to Figure 3 this magnetic flux B can be resolved along the three axes of 
the coordinate system to give Bx, By and Bz and subsequently resolved along the axis of the sensor thus: 

75 B xy = B x COS ♦ + B y Sin * P) 

and 



20 



B 6 = B z cos G + B^ sin 0 



(2) 



25 



The voltage V s , induced in the sensor is related to the flux density via V 6 = kg B s where kg is known and is a function 
of the frequency of the field and the characteristics of the sensing coil, it therefore follows from (1) and (2) that the 
voltage induced in the sensor at any x-y-z location and for any 8-<|> orientation is given by, 



V s = k 6 (B 2 cos 6 + sin 6(B X cos <j> + B sin (j>)) 



(3) 



30 



Formulae defining B*, By and B 2 are developed from standard near field electromagnetic theory in Appendix-A. 
Upon substituting the terms for B*, B y , B z from equations (A-1 2) to (A-1 4) into (3), it can be shown that, 



35 



* 2 - jsL 



v 2 ) cos6 + 32 sinB fx cofiA + y sin<hl^ (4) 
(X 2 + y 2 



* 2 + v 2 ♦ Z 2 ) 5 ' 2 



where ^ is. known and is a function of the current through, diameter of, and number of turns on the generating coil. 
The five unknown quantities, x, y, z, 6 and <|> are evident in (4): all other variables are known. 

Equation (4) has been derived, as stated above, for the case of a single generating coil 3 directed along the z- 
axis, there will of course be a corresponding equation for each of the three generating coils 3 of each of the three field 
generators 1 . 

It has been found that despite the complexity of this term (4) it is possible to determine the location and orientation 
of a single sensing coil by sequentially energising each generating coil. To explain this approach to position location 
the two dimensional case will first be considered. 

Figure 4 shows a field generator comprising two orthogonal field generating coils D x and D y located at the origin 
of the coordinate system. The single sensing coil sensor is located at P and its axis is parallel to direction S. The angle 
a is the angle between vector direction R of the sensor from the origin, and the direction S of the sensor axis. 

The voltages induced in the sensor when coils D x and.D y are energised sequentially are respectively, 

V 6Dx = M B RDx cosa " B eDx sinct ) (5) 

and 
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V sDy = k s( B RDy C0Sct + B eDy sinot ) ( 6 ) 

where the D x and D y sub-suffices relate to the field generated by the D x and D y coils. Upon substituting (A-1 ) and (A- 
5 2) from Appendix-A, (5) and (6) become, 

k k 

V sDx = ~*~t ( 2cos6 cosa " s ' nG s ' na ) ' ( 7 ) 
R 



10 



20 



25 



35 



40 



45 



and 



k k 1 
V sDy = (2sin6 cosa + cose sina) (8) 

15 R 

It has been noticed that the value of V(V sDx 2 + V sDy 2 ) remains constant for a constant value of a. 
From (7) and (8) we can write, 



k k 

^( V sDx 2 + V sOy 2 ) = "^F ( 4cos20cos2a + sin 2 6sin 2 a 
R 



-4sin9sinacosecosa 



2 2 2.2 

+4sin 0cos a +cos 6sin a 



V6 

,+4sin6cosacosesina) (9) 



30 which reduces to, 



V sDx 2+V sDy 2 = :£ T^ 1+3COs2a < 1 °> 



This can be thought of as corresponding physically to a circle of constant induced voltage in the sensor, centred 
on the field generator at the origin and lying in the x-y plane. This concept is shown schematically in Figure 5. If the 
twn individual measurements of induced voltage V sDx and V sDy measured at the sensor are used to calculate 
*/ V sDx 2 + V sDy 2 a circu,ar of rotating field of constant strength can be simulated since ^/V sDx 2 + V sDy 2 represents the 
maximum voltage that could be induced in the sensor if a rotating field were used. This is desirable since equation 10 
gives a very simple relationship between R and a. 

The extension of this analysis to three dimensions is readily performed mathematically and conceptually very 
powerful because the approach taken does not require the axis of the generated field to be steered towards the sensor, 
but simply requires sequential energising of the individual generating coils. Thus for position determination in three 
dimensions of a single coil sensor, assuming three mutually perpendicular generating coils located at the origin of the 
coordinate system, we have 



so ^sox 2 * V 8Dy 2 + V 8DI 2 = ^ h + 3cos 2 a (11) 



It should be noted that the term 7l + 3cos 2 a can only take values between 1 and 2, ignoring negative solutions 
and thus any value of R computed from (11) is only weakly dependent on the value of a. For example, if a is assumed 
to be n/2 whereas its correct value is zero, the value otRcnmpntftd from (11) is 80% of its correct value. This in fact 
55 represents the worst case scenario since a=0 means V1 + 3cos a = 2, while a=rt/2 means 4 1 + 3cos a = 1. 

Hence for each of three field generators a bounded value for R, the vector distance of the sensor from that particular 
field generator, can be calculated without any knowledge of the orientation a of the sensor. Since there are three field 
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generators located at different known positions in the same plane (the x-y plane) and the distance R from each of them 
to the sensor has been calculated, the x-y-z coordinates of the sensor can be determined from simple trigonometry. 
This positioning methodology is shown schematically in Figure 6. The three simulated spheres of constant induced 
voltage centred on each of the three field generators, and bounded by the potential error in R, overlap at two regions. 

s One region is above the plane of the field generators and the other is below. In most applications, one solution is clearly 
erroneous and the location of the sensor can easily be uniquely determined. 

At this stage the location of the sensor (but not its orientation) has been calculated to a limited degree of accuracy. 
For some applications this may be adequate, but in general the precise location and probably orientation of the sensor 
are required. This is achieved by the use of an iterative procedure in which the estimate of the x-y-z coordinates of the 

w sensor, derived from the values of R for each of the three field generators, are used in the appropriate equation (4) for 
each of the nine generating coils to estimate values of 0 and <J> for the sensor, from these a is calculated for each of 
the three generators. Although 9 and 4 could be calculated from only two versions of equation (4), all nine versions 
are employed to improve the rate of convergence of the solution and its immunity from noise. The three values of a 
can then be invoked in the appropriate equation (11) for each field generator to calculate an improved estimate for R 
for each of the generators. This process is repeated, progressively reducing the error in R and a for each generator 
until the desired levei of accuracy is achieved. It should be noted that this technique avoids the problems of non- 
convergence which would arise if equation (4) were utilised directly because a good estimate for R has been found 
before equation (4) is employed, and the estimate for R is bounded as shown schematically in Figure 6. 
In summary, and with reference to Figure 7, the algorithm utilised by the controller 6 is as follows:- 

20 

1 . Assume ct=0 initially. This ensures an over-estimate of R which guarantees an intersection of the radial distances 
from the three generator. 

2. M e asure the vo l tage s induced in the sensor by each of the 9 individual generator coils, and then compute 

v V sDx 2 + ^sDy 2 + ^sDz 2 * or eacn °* tne tnree Generators. 
25 3. Invoke a in (1.1) and compute R for each of the three generators. 

4. Compute the x-y-z coordinates of the sensor from the three values of R. 

5. Invoke these coordinates in the appropriate version of equation (4) for each of the nine generating coils and 
compute an improved estimate of 8 and <|>. This can be achieved by the use of, for example, the Gauss-Newton 
Least Squares optimisation technique. 

30 6. Use the improved estimates of 6 and <J) to calculate a for each generator. 

7. Return to step 3 until the difference between the new and previous estimates of a reaches a sufficiently low 
value commensurate with the required positional accuracy in the x-y-z coordinates being achieved. 

Figure 8 depicts schematically the three spheres of constant induced voltage when the errors in R have been 
35 reduced to allow the location of the sensor to be determined uniquely The technique employed thus guarantees con- 
vergence to a unique location, with a precision that can be chosen in accordance with the requirements of the appli- 
cation. Indeed, it should be noted that in applications where the sensor is moving within the magnetic field, the number 
of iterations can be chosen dynamically for each calculation of the location of the sensor, thereby improving the effi- 
ciency of the process. For example, the first placement of the sensor typically requires 10 iterations before the solution 
40 is considered to have converged: this is considered to be so when the mean-square difference between the present 
and previous values of a is less than 10- 6 . Even with rapid movements of the sensor, it is unlikely that its angle a will 
change markedly from one positional placement to the next. By using the final value of a arrived at during the first 
placement as the initial estimate in the second placement, the number of iterations required to achieve the same 
convergence is significantly reduced. And so on for all subsequent placements. Experiments have shown that as few 
4S as 3-5 iterations are required for convergence after the initial placement. 

Although the algorithm described above with reference to Figure 7 ensures convergence to a unique location, 
allows both the location and orientation of a single coil sensor to be determined, and has proved to be robust even in 
the presence of noisy signals from the sensor coil 7, a second, alternative algorithm has been developed which has 
further advantages. 

50 The first algorithm requires, at step 5, the solution of nine simultaneous equations relating 9 and <J> for each of the 

field generators to the estimate of the x, y and z coordinates of the sensor. This calculation can, dependent on the 
processing power of the controller 6, be time consuming, hence a second algorithm which is less computationally 
intensive has been developed. This algorithm enables the location and orientation of the sensor 7 to be determined 
more rapidly. The second algorithm is based on the realisation that mathematically the voltages induced in the sensor 

55 7 by each set of three generating coils 3 comprising each generator can be treated as vector quantities. This mathe- 
matical treatment enables an angle \j/ between the magnetic field lines and the direction vector of the sensor from a 
generator to be calculated. Once the values of y for each generator have been found there is no need to employ 
equation (4) since the values of a can be calculated directly from the values of y given a knowledge of the form of the 
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magnetic field. Since nine versions of equation (4) need no longer be solved this algorithm is computationally less 
intensive than the algorithm of Figure 7. 

The second algorithm will now be described in greater detail. In order to explain the algorithm clearly and to dem- 
onstrate the mathematical insight on which it is based, the roles of the generating coils 3 and sensor coil 7 will be 

s reversed i.e. for the purpose of the calculation the single axis field sensor 7 will be replaced by a continuously energised 
single axis field generating coil and the three orthogonal three-axis field generators will be replaced by three orthogonal 
three-axis field sensors. This is shown in Figure 9. Although it should be stressed that the reversal of roles here is 
simply for the purpose of mathematical elegance, this reversed configuration will in practice be feasible and in some 
—position location applications may be desirable. 

10 Referring now to Figure 9, let the vectors joining each three-axis sensor (10) to the single axis generator (11) be 

Ev f?2 and Ba and 'I 3 * tne angles between these vectors and the generator be a, , ccg and 03. The field produced by 
the single axis generator (11) will pass through each three-axis sensor (10), and the magnitude and direction of the 
field may be determined by processing the signals produced by each of the three orthogonal sensor coils (1 2), forming 
each three-axis sensor (10), in response to the field. Let the signals in each of the three-axis sensor (1 0) be represented 

is by the vector quantities V| , V 2 and V 3 , where each component of the vectors corresponds to the signal in each of the 
orthogonal sensing coils (12). Let the angle between the field at each three-axis sensor (10) and the vectors R 1( R 2 
and R3 be y v y 2 and \j/ 3 respectively, as shown In Figure 10. 

For the first estimate of the position of the generator 1 1 , the orientation of the generator (11 ) is unknown, and a, , 
ot2 and (Xg are assumed to be zero. The magnitude of the vectors R v and R 2 and R 3 are then calculated from equation 

20 (11 ). As for the first algorithm, because of the nature of equation (11 ) a bounded value for the distance of the generator 
(11 ) from each of the three-axis sensors (10) is found and the overlap of these bounded values can be used to give 
an initial estimate of the x, y and z components of each of the vectors R^ R 2 and R 3; 
The angles y v y 2 and y 3 are then calculated using the dot product, as follows: 

25 V"n = |^|P s |cOS Vn 



30 



cosy n = 



Having found y n> we need to find to improve the estimate of position. Referring to Figure 11 y is the known 
angle and a is the required angle, d represents the calculated distance from the generator to the sensor. 

Since the generator is a simple dipole, the field at the sensor is given from equations (A-1 ) and (A-2) of the Appendix 

35 by: 



40 



45 



so 



55 



= |22jj cos a 



B glk lsina 



The angle of the field at the sensor is given by: 



-B a i 
tany = - - tana 
B d 2 



and so a is obtained from y using: 

tancc n =-2tany n 



Having found a new estimate for a n , a new estimate of the generator position is calculated using equation (11 ). 
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The process is repeated until the position converges to the required degree of accuracy. 

Once the position of the generator (1 1 ) has been determined in terms of R n and the orientation of the generator 
may be calculated in terms of e and 4 as follows. 

Let U be a unit vector defining the orientation of the generator relative to the sensors. Using the dot product, we 
s can set up three equations to determine the three unknowns in U. 

R v U = |R.,| ILJIcosa, =|R 1 | cosa, 
10 R rU = | R 2| iyicosa2 = |R^ cosa 2 

R 3 . U - jRgJ IUI cosag = |Rg| cosa 3 

15 

These linear equations are solved to find U, and then the orientation in terms of e and 4> is given by: 



20 



9 « arctan 



U, 



25 



$ = axctanl U t ) 

30 



(note that a four quadrant arctan function should be used). 

3S Although the formulation of the second algorithm has thus far been for the case of a single axis generator and 

multiple axis sensors the algorithm can be applied to the case of a single axis sensor and multiple axis generators. 
The only modification required between the two cases is the method by which the raw data for the algorithm (i.e. the 
voltages induced) is acquired. The equations developed above are directly applicable to the single axis sensor multiple 
axis generator case since the magnetic coupling between two coils is the same irrespective of which of the two coils 

40 is being driven. 

The steps to be followed when employing the algorithm for the single axis sensor and multiple axis generator case 
will now be summarised: - 

1 . Sequentially energise each of the three generator coils in each of the three generators 1 and measure the 
45 voltage induced in the sensor coil 7 by each generator coil i.e. measure V 1x , V 1y , V 12 , V 2x , Vgy, V^, V 3x , V 3y , V 3z . 

2. Invoke in equation (11) and compute (Rj for each of the generator 1, 2 and 3. (for initial estimate set a=0). 

3. From the intersection of three spheres of radius |Rj calculate the vector quantities R 1 , R 2 and R 3 . 

4. Taking the three voltages induced in the sensor coil 7 by a single generator 1 as a vector quantity e. g. 

y i= V 1x x + V ly y + V l2 z 



calculate the angle of the field y n from the dot product V n . R n . 

5. Calculate the angles between the vectors^ and the sensor axis from y n and equations A-1 and A-2. 

6. Repeat steps 2 to 5 until the desired level of positioning accuracy has been achieved. 

7. Use final values of c^ and R n to calculate the orientation of the sensor coil in terms of 0 and <|>. 

It has been found that use of the second algorithm can improve the speed with which the location and orientation 
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of a sensor is determined by a factor of approximately 15 compared to the first algorithm. 

For both algorithms the location and orientation of more than one sensor can be determined without the need to 
replicate the field generators 1 and amplifier 5. The field generated by any one field generating coil is measured at 
each of the sensors and the location and orientation of the sensors are simultaneous and independently calculated. 
5 The positions of the sensors may of course all be displayed on a single display unit 9. 

The simple, small sensor used in this embodiment means that it can provide position location in many situations 
where there is insufficient space for the three coil orthogonal sensor used in prior art position location systems. A 
particular field of application is the medical field, where access through body vessels is required, for example in en- 
doscopy or non-invasive cardiovascular heart surgery. In these medical situations the present location system may 
10 replace the use of x-ray imaging (fluoroscopy), giving considerable advantages in cost and eliminating x-ray exposure 
to both patients and medical staff. The low frequency magnetic fields used by the present system render the human 
body transparent, while the use of low field strengths ensues the system is intrinsically safe. 

During endoscopy it is desirable to know the path of the endoscope through the body This may be achieved using 
the present location system in three ways. Firstly, the single sensing coil may be pulled along the biopsy tube and its 
*5 position at regular intervals along the tube stored and displayed to provide a 3D map of the path. Secondly, a tube 
containing approximately a dozen single coil sensors may be placed in the biopsy tube of the endoscope and the 
location of each of the sensors determined. This would be a retro-fit to existing endoscopes. Alternatively, the single 
coil sensors may be placed in the wall of the endoscope during manufacture. In the second two cases a real time 
picture of the path of the endoscope would be available at all times to the endoscopist. 
20 The present positioning system has been utilised in clinic field trials to image in three dimensions the total config- 

uration of a colonoscope within the human abdomen. A sensor according to the present invention was placed inside 
the biopsy channel of an endoscope. 

The small inner diameter of the biopsy channel, typically 3. 7mm for a colonoscope, not only dictates that the 
sensor be of vanishingly small diameter, but also that it may only comprise a single coil, typically 1cm in length, orien- 
ts tated along the axis of the instrument. The algorithms of the present positioning system processes the signals from 
this sensor in such a way as to calculate the position of the sensor within the biopsy channel independent of its orien- 
tation. Such independence is crucial in colonoscopy since the sensor may adopt any orientation for a single x-y-z 
location. 

The positioning algorithm resides as software within an IBM 486 personal computer which, upon processing the 

30 information taken from the sensor at numerous discrete positions along the biopsy channel, then displays the path 
followed by the sensor as a continuous line on the monitor. Clearly this path corresponds precisely to that of the en- 
doscope. Moreover, because the information from the sensor at each location relates to three dimensions, the imaged 
path on the monitor is likewise displayed in three dimensions. Visually the system achieves this by the use of "grey 
scale" colour coding whereby portions of the path further from the viewer (i. e. down into the screen) appear in darker 

35 - shades of grey than the "under" portion. This feature is unique among all conventional imaging techniques for colon- 
oscopy and represents a major advance in the field. 

To display the path of the endoscope, the endoscopist first passes the sensor down the biopsy channel until it . 
reaches the tip of the endoscope. For convenience we have encapsulated the sensor within a hollow tubular catheter 
of the type used routinely with endoscopes. The catheter is then withdrawn at a uniform speed (although this is not 

40 critical) while the system repeatedly determines the position of the sensor at discrete instances during its motion. During 
withdrawal the path of the instrument is displayed on the monitor in three dimensions. In many situations a total image 
of the endoscope is not required, in which case the sensor need only be withdrawn along that portion of the instrument 
of interest. To cater for patients lying in a variety of positions, perhaps changing during the investigation, the image 
may be rotated in any direction. This is particularly advantageous in establishing the radius of curvature of any bend 

45 jn the endoscope that happens to lie along the viewing axis. For example, a bend that is in fact gradual, and hence 
poses no concern, can appear abrupt if viewed from some directions. A useful zoom facility on the image is also 
provided. When the system is in normal use, the system display would ideally be sited next to a standard camera 
monitor used to display the view from the endoscope. In this way the endoscopist is conveniently presented with the 
path of the instrument in three dimensions on one display, and the internal view from the endoscope optics on the other. 

so initial validation of the system was performed with the aid of a rigid plastic framework to hold the endoscope in 

one of a number of predefined configurations. X-ray imaging and the present magnetic field system were applied to 
seven different configurations of the endoscope. These included a sigmoid loop, an alpha loop, a reverse alpha loop, 
a gamma loop, and an "N" loop. The results, three of which can be seen in Figure 12 showed close agreement between 
the image produced by the present positioning system (shown on the left) and the X-ray image (shown on the right) in 

55 each case. The nature of the overlapping portions of the colonoscope can be clearly seen from the images produced 
by the present positioning system. Some distortion of the images was caused by the metallic construction of the colon- 
oscope perturbing the magnetic fields. However, this was minimal and the colonoscope configuration is clearly evident 
from the images/ 
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The clinical trails involved three patients undergoing colonoscopy for a number of different indications. Ethical 
approval was obtained, as was written consent. The patients were sedated with a combination of pethidine and mida- 
zolam before the examination. The colonoscope used was a Pentax type FC38LH. 

For the majority of each examination, the sensor was fully inserted into the biopsy channel, and the display was 
configured to show the progress of the tip of the endoscope in real time. When progress became difficult, the sensor 
was withdrawn, which immediately produced an image on the screen of the total path of the endoscope. With the aid 
of this image the removal of loops was straightforward, by using clockwise or anti-clockwise twist and simultaneous 
withdrawal of the endoscope. Similarly, when re-inserting the instrument the reformation of loops was prevented by a 
combination of abdominal pressure and torque. Where abdominal pressure was required the sensor-was positioned 
in the loop, so enabling the endoscopist to see, by referring to the displayed image, whether pressure was being applied 
in the desired direction and to the correct extent. In each case examination around to the caecum was achieved (i.e. 
total colonoscopy) and the procedure was tolerated well by the patients. During the examinations, X-ray pictures were 
taken for comparison against those obtained with the magnetic system. Two of these, a plan and side view, are shown 
in Figure 13 together with the corresponding image from the magnetic system. Agreement between the two is very 
close, the deviation being largely attributable to patient movement between the two exposures. 

The system has been shown to image the configuration of the endoscope within the patients's abdomen with close 
agreement to the X-ray image. The three dimensionality of the image has proven to be of great help in deciding the 
strategy for removing loops which form in the path of the endoscope during intubation. Indeed, this improvement in 
visualisation is likely to be of great benefit in teaching colonoscopy, as well as enabling experienced endoscopists to 
improve their technique when facing difficult cases. The intrinsically safe nature of the system allows it to be in con- 
tinuous use throughout the examination, presenting the endoscopist with as many images as the circumstances require. 
This contrasts markedly with fluoroscopy which can only offer images intermittently and carries an exposure time limit 
for reasons of patient safety, and X-ray pictures which are essentially only a "one-shot' option. Moreover, protective 
clothing need not be worn by any of those present at the examination while the system is in use, nor is it necessary 
for the examination room to be in any way specially prepared. Indeed, the system frees such examinations from having 
to take place in a room apart from the ward. If need be such examinations could be carried out in complete safety and 
with no loss in overall integrity, at the patient's own bed in the ward. 

A number of medical studies have considered the efficacy of colonoscopy as a screening methodology in asymp- 
tomatic subjects and have shown a significant detection rate for adenomas and carcinoma in subjects over the age of 
60. Of particular note here is that some 50% of lesions were proximal to the splenic flexure, hence the importance of 
performing a total colonoscopy in such cases. The ability to conduct total colonoscopes routinely and efficiently is 
therefore an important objective. On the other hand it must be remembered that colonoscopy (total or otherwise) is 
associated with a certain morbidity and mortality due to the need to apply mechanical stress during intubation or with- 
drawal. The overall improvement in visualisation that the present system affords, particularly it's three dimensionality, 
should both raise the efficacy of total colonoscopy and reduce the risk of perforation. This in turn may also help to 
reduce the dosage of analgesic and sedative drugs required. 

Although the application of the present positioning system to colonoscopy has been specifically addressed, the 
scope of the medical applications extends far beyond this by virtue of the very small size of the sensor(s). For example, 
bronchoscopy, gastroscopy and procedures involving a nasogastric or endotracheal tube could all utilise the sensor 
described herein its present catheter form. Numerous other medical applications requiring position or orientation in- 
formation could benefit from either a single or multiple sensor implementation of the system. 

Data gloves which facilitate the location of a wearer's hands, are used in both medical and virtual reality applica- 
tions. They enable the position and direction of each of the fingers to be determined. The prior art magnetic field location 
system using a three coil orthogonal sensor is clearly not applicable, so current data gloves use fibre optic strain 
gauges. These require calibration every 2-3 minutes. The ability to locate single coil sensors means that the sensors 
may be wound around each joint of each finger giving a system which is less bulky, more accurate and only requires 
calibration during the manufacture of the gloves. 

A particular area of application for the present positioning system comprises that of the so called "man-machine 
interface". There are numerous situations in which a human operator needs to interact with a machine, or computer, 
normally comprising some form of display device, examples of such interactions are with a conventional personal 
computer, a video conferencing system, or a virtual reality environment in which the operators field of view is filled by 
the display device, which in this case may be three dimensional. The present positioning system allows an operator 
to wear small, single coil sensors about his body to enable his movements to be detected and interpreted by a machine 
without the need for physical contact between the operator and the machine. For example the positioning system of 
the present invention could enable an operator to interact with images on a television or computer screen without the 
use of a conventional keyboard, mouse or stylus. The operator could wear single coil sensors on his fingertips, for 
example in thimbles, or a thin glove, the location and orientation of which could be detected within a magnetic field 
generated within the vicinity of the display screen. Linking the positioning system to the computing system would allow 
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the computing system to have knowledge of the position of the operators fingertips ih three dimensions. A computer 
drawn replica of the user's hand which precisely emulates the movements of the user's own fingers, could then be 
utilised by the user to interact with the computer system; Thus when the user makes hand movements the virtual hand 
on the screen can be made to grasp and manipulate objects in the display, for example moving portions of text, rotating 

5 an engineering drawing, selecting an icon to activate a software program, etc. The virtual hand could also be used to 
control windows and menus and to draw diagrams. The advantage of such a man machine interface is that its use is 
completely intuitive, requiring no training. 

Since the positioning system of the present invention enables the position of a sensor to be located in three di- 
mensions, the extension of such a man machine interface to a three dimensional virtual reality environment is clearly 

10 possible. In this case the computer system involved may need information regarding the position of other parts of the 
operator' body than his hands, for example the image displayed to the operator may be dependent on the location and 
orientation of his head, in which case small single coil sensors can clearly be worn for example on each temple.. 

In a second embodiment the invention enables a sensor, comprising three orthogonal sensing coils, to be located 
in three dimensions relative to a single field generator comprising three orthogonal generating coils. 

*s With reference to Figure 14, a field generator 1, comprising three generating coils 3, as previously described is 

mounted on a surface 2. Each generating coil is electrically connected to an amplifier 5 and is driven as previously 
described. 

The sensor 7 in this embodiment comprises three mutually orthogonal sensing coils, A, B and C t each of which is 
separately electrically connected to a measurement unit 8. 

20 in use the three generating coils are sequentially energised as previously described, but when each coil is energised 

the voltages induced in each of the three sensing coils V A , V B and V c are measured by the measurement unit 8 and 
stored by the controller 6. The controller 6 then calculates from these three voltages the location of the sensor 7 relative 
to the single field generator 1 . 

The controller is able to calculate the location of the sensor, even though the axes of the generated fields have 

25 not been directed towards the sensor, by employing an algorithm which weights the voltages induced in the three 
sensing coils by a location dependent weighting, and then alters these weightings to achieve a calculated maximum 
field strength at the sensor. In order to more fully describe this algorithm the field from a single small coil is first con- 
sidered. 

The magnetic field produced by a small coil, from equations (A-1) and (A-2), is given by: 

30 

B = \ (2a D cose + a a sin 6) (12) 
" R " R " e 

3S where 

R = distance from the coil 
9 = angle from the axis of the coil 
k = constant for coil (size, drive current, no. turns etc). 
40 a R is a unit vector in the direction of B R (see Appendix A 

a e is a unit vector in the direction of Be (see Appendix A 

Now, the magnitude of the magnetic field 

45 

|B|=^V(3cos 2 e + 1) (13) 



and so it can be seen that for a given distance from the coil, the field strength is greatest when 8=0 i.e. on the axis of 
so the coil. Clearly, if the effective axis of the coil could be directed towards the sensor, the sensor would experience a 
maximum in field strength. 

In order to steer the effective axis of the coil without physically moving it, additional coils are required. To steer the 
effective axis over 3D, three coils are required in total. Assuming three mutually perpendicular coils D x , D y , D z lying 
along each of the cartesian axes x, y and z, each coil being centred on the origin, by setting the currents to each coil as: 

55 

l x = Icos0cos<|> f 



-Fig. A-1) 
-Fig. A-1) 
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I = I cos 9 sin* 



_ I = I sine 

s * 

the effective axis of the resulting field may be steered without changing the magnitude of the field. * is the angle 
anticlockwise from x in the xy plane, and 6 is the elevation towards the z axis. 

Assuming the notation of Figure 2, OP represents the effective axis of the field. That is a single drive coil, centred 
io on the origin, with its axis along OR fed with current I, would create the same field as the three coil arrangement with 
the currents l x , l y and l z as described. 

Thus if the field strength at the point we wished to locate could be measured, we would find that when axis OP 
pointed at this point, the field strength would be a maximum. 

The field strength is measured using 3 orthogonal sense coils, centred on a single point. In this case an AC field 
is must be used in the drive coils. Let the sensor coils be A, B and C, and let the amplitude of the voltages induced be 
V A , V B and V c . The field strength can be computed from 

B = k s (V A 2 +V B 2 +V C 2 )* 

20 

where kg = a constant for the sensor and frequency used. 

The effective axis of the resulting field, could be physically steered towards the sensor, and V A , V B , V c monitored 
to maximise B. However this is difficult in practice to achieve since both 9 and * would need to be simultaneously 
altered while measurements from the sensor are taken. This leads to slow position location, and limits the system to 
25 locating a single sensor. The approach adopted in this embodiment is as follows. The drive currents for all the coils 
are set to I, and not to the values which would be required to physically steer the effective field axis, as discussed above, 
i.e. 

I x = l 

30 ly=l 
l 2 =l 

Effectively steering of the field axis is carried out AFTER the field measurements have been made by weighting 
or scaling these measurements by location dependent weighting factors. Thus, instead of physically altering G, <f> and 
35 then measuring B, the following technique is used. 

1 . Switch on D x , with l x = I 

2. Measure V ADx ,V BDx ,V CDx 

3. Switch off D x ; Switch on D y> with l y = I 
40 4. Measure V ADy , V BDy , V CDy 

5. Switch off D y ; Switch on D z , with l 2 = I 

6. Measure V ADz , V BDz , V CDz 

7. Switch off D z 

45 For the physically steered field: l x = I cos9cos<j>, rather than I. The same result is achieved by weighting the results 

from step 3 by cos9cos((>. The same logic applies to the remaining results, using the relevant weighting factor. 
Thus: 

so B 2 = k 8 2 <((V ADx cos* + V ADy sin*)cos9 + V ADz sine) 2 

+ <(V BDx cos* + V BDy sin<t>)cos9 + V BDz sinG) 2 
+ ((V CDx cos* + V CDy sin*)cos9 + V CDz sin9) 2 ) 

55 

Note that the "signs" of the amplitude are important 

e.g. 
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phase shift = O => +ve 



phase shift -n => -ve 



10 



In this expression for B 2 , 9 and $ are the only variables. 

In order to find the values of 8 and <j> which give the maximum B 2 the Gauss-Newton optimisation technique is 
used. This copes well with sum of squares type expressions. The expression tor B 2 is well behaved, and only a few 
iterations are required. 

In order to find the precise location of the sensor we must now find R. 

If. we square and sum the field magnitudes at the sensor for each generator coil, we find that: 



15 



no 

Ir 3 



and so R may be found from: 



20 



R 3 = k c / 



V + lfiJ 



The cartesian coordinates of the sensor are then 

25. 

x = R cos8cos<|) 

30 y = R cosGsin<t> 

z = R sine 



35 As with the first embodiment the location of multiple sensors is facilitated because the generating coils are only 

energised sequentially allowing the generated field to be simultaneous measured at any number of locations. 

Although in both embodiments of the invention described herein the voltages induced in the sensor coil 7 by the 
generating coils 3 are distinguished one from the other by employing a time multiplexing approach, i.e. the generating 
coils are energised sequentially, a frequency multiplexing approach may also be adopted within the scope of the present 

40 invention. For example in such an approach each generator coil 3 could be driven at a different frequency so that a 
plurality of generating coils 3 could be simultaneously energised while still allowing the voltage induced in the sensor 
7 by each generating coil to be distinguished by its frequency. In such an arrangement the sensor would need to be 
responsive to all the energising frequencies and some form of frequency filtering would need to be provided. This 
filtering could be provided by discrete physical bandpass filters electrically connected to the sensor 7, or, if an A to D 

45 converter is employed as described herein, tittering of the signal from the sensor 7 can be accomplished by signal 
processing software in the controller 6. The use of frequency multiplexing to acquire the data for position determination 
can significantly increase the operating speed of the positioning system since measurements from generating coils 
can be taken simultaneously. Disadvantages of such a frequency multiplexing system are that it is more compiex than 
a time multiplexed system and requires greater electrical bandwidth. A combination of time and frequency multiplexing 

so could of course be used. 

In both embodiments it is desirable that the quasi-static magnetic field generated by a coil is established quickly 
and is allowed to decay quickly. For this reason it is preferred to use a first order rather than a second order drive 
circuit. For the generating coils employed the field settles within one cycle of being switched on. 

It will be appreciated that alternative configurations of both embodiments for different applications, for example 

55 locating a sensor within a two dimensional plane, are envisaged within the scope of the present invention. 

As will be clear to one skilled in this art, the roles of the generating and sensing coils may be reversed while still 
benefitting from the advantages of the present invention. That is the sensing coil or coils may be used as field generating 
elements, and the generating coils may be used as field sensing elements. 



14 



EP 0 655 138 B1 



This reversal of roles has particular advantage where a static field, such as that generated by a bar magnet is 
employed according to the first aspect of the invention, since such a field generating element must be effectively 
permanently "energised". The reversal of roles allows the "sensor'* permanently to generate a field which is sensed at 
each of the "generating elements" and the location and orientation of the "sensor" is then determined as before. 

Appendix A 



10 



Consider a current, I, flowing through a small planar coil of radius, b, (Fig A-1 ). The frequency of I is chosen to be 
sufficiently low such that static field distributions apply. 



75 



20 




25 

Fig A-1 , Resolving magnetic flux density at a distance. 

For a point P in the field whose distance R from the coil is such that R»b, it is readily shown for example in D K 
Cheng, Field and Wave Electromagnetics, 2nd Ed, Addison Wesley, 1989, that 

2 k e cos 9 

B R = — -g— (A-1) 
R 

and, 

k„ sin 6 
R 

40 where k c is a known function of I and b. B R and B e represent the vector components of the magnetic flux density at 
point P resolved along axes parallel to the line R and the angle e. Note that, by convention, 6 is measured from the 
axis of the coil. 

In order to resolve the magnetic flux density at P onto a 3-dimensional cartesian coordinate system, consider first 
the coil in the y-x plane, centred on the origin (Fig A-2). 

45 



30 



35 



SO 
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Fig A-2. Resolving magnetic flux density onto an x-v-z cartesian coordinate system. 

If point P is distance x.frnm the coil (Le. origin) along the x-axis and its vector distance is R, the distance in the y- 



z plane by Pythagoras is VR 2 - x 2 . Since R 2 = x 2 + y 2 + z 2 , this distance reduces to Vy 2 + z 2 , as shown. It then follows 
that, 



(A-3) 



and, 



cose = £ 

Resolving the magnetic flux density at P onto a cartesian system gives, for the x-axis component, 



(A-4) 



From (A-1) and (A-2) this becomes, 



B x = B R cos 6 - B 0 sin 6 



B x = -^|(2 cos 2 0- sin 2 6) 



and from (A-3) and (A-4), 



B x = -|(2x 2 -y 2 -z 2 ) 
R 



(A-5) 



Resolving similarly onto the y-z plane gives, 

B^ = B R sin $ + B e cos <|> 

which from (A-1) and (A-2) becomes, 



B w = -^(3 cos 6 sin 6) 
* R 



and from (A-3) and (A-4), 
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B yz = -f(3xVy 2 + z 2 ) 
y R 



(A-6) 



10 



15 




Fig A-3, Resolving the magnetic flux density at P onto the v-z plane. 

Resolving the magnetic flux density at P into its y and z components (Fig A-3) gives, 



20 



25 



and, 



30 



B - ■ ****** - Hs£?) 



35 From (A-6) these become, 



40 



and, 



B y = ^ 5 (3xy) 



(A-7) 



45 



B 2 = ^ s (3xz) 
R 



(A-B) 



For a coil (dipole) in the y-z plane, equations (A-5), (A-7) and ( A-8) f uffy describe the resolved cartesian components 
of the magnetic flux density at a point P located at a radial distance R from the coil. The corresponding equations for 
coils in the x-y and x-z planes can be developed in an identical manner. The complete set of formulae can therefore 
so be summarised thus. 

For a coil in the y-z plane :• 



55 



k_ 2 2 2 

B x = -^ s (2x 2 -y -z 2 ) 



(A-9) 
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For a coil in the x-y plane :- 



15 



For a coil in the x-z plane : 

25 
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B y = ^(3xy) (A-10) 
R 



B 2 = %3xz) (A-11) 
R 



B x = -|(3xz) (A-12) 
R 



B y = -% (3yz) (A-13) 
R 

20 B z = -I < 2z2 - * 2 ■ y 2 ) ( A " 1 4 ) 

R 



k 



R 



B x = ^(3xy) (A-15) 
R 



30 B v = -^f(2y 2 -x 2 -z 2 ) m (A-16) 

y R 

B z = ^(3yz) (A-17) 



Claims 

40 1 . A method of determining the location and/or orientation of a field sensor (7) relative to a plurality of field generators 
(1) of known location, each field generator (1) comprising a plurality of collocated field generating elements (3), 
each generating element (3) being energised and a measurement being made at the field sensor (7) of the re- 
spective field generated by the generating element (3), the method being characterised by the steps of: 



45 1 ) ) for each field generator (1 ) calculating, from the measurements of the field generated by each of its gen- 

erating elements (3) and an estimate of the orientation of the sensor (7), an estimate of the distance from that 
particular field generator (1 ) to the sensor (7), and 

2) utilising the estimates of distance from step 1 ), and the known location of the field generators (1 ) to calculate 
an estimate of the location of the sensor (7); 
so 3) employing the estimated location of the sensor (7) from step 2) and the measurements of the field at the 

sensor (7) to calculate a new estimate of the orientation of the sensor (7); 

4) repeating steps 1 ) to 3) iteratively, with step 1 ) employing the new estimate of sensor orientation from the 
preceding step 3), to improve the estimates of location and orientation of the sensor (7). 

55 2. A method as claimed in claim 1, wherein each generating element (3) of each field generator (1) is energised in 
sequence so that only one generating element (3) is energised at any given time. 

3. A method as claimed in claim 1 , wherein at least two generating elements (3) are simultaneously energised, each 
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of these at least two generating elements (3) being energised at a different frequency from the other simultaneously 
energised generating element(s) (3). 

A method as claimed in claim 1 wherein at step 3), the estimated location of the sensor (7) calculated in step 2) 
and the measurements of the field at the sensor (7) are used to calculate, for each field generator (1 ), the direction 
of the respective field at the sensor (7) and from these field directions calculating a new estimate of the orientation 
of the sensor (7). 

A method as claimed in claim 1 or claim 4 wherein, at step 1), the initial estimate of the orientation of the sensor 
(7) is taken to be the orientation as calculated by the immediately preceding application of the method or, if this is 
the first application of the method, the axis of the sensor (7) is initially assumedto be directed towards the respective 
field generator (1). 

A method of determining the location of a field sensor (7), comprising a plurality of collocated field sensing elements 
(A,B,C), relative to a field generator (1 ) comprising a plurality of collocated field generating elements (3), each field 
generating element (3) being energised in turn and the value of the resultant field strength being measured at the 
field sensor (7), the measured field strength being dependent on the location of the sensor (7) within the respective 
field, the method being characterised by the steps of: 

1 ) calculating, by utilising ail the values of measured field strength and an estimate of the direction of the 
sensor (7) from the field generator (1 ), a direction dependent weighting factor for each field generating element 
(3) so that the calculated field strength B is equal to the field strength B that would exist at the sensor (7) if 
the axis of the field were directed towards the sensor (7), 

2) iteratively altering the direction dependent weighting factors to maximise B and thus to determine to a 
desired level of accuracy the direction of the sensor (7) from the field generator (1 ), and 

3) employing the measured values of the field strength to calculate the distance of the sensor (7) from the field 
generator (1) and hence, from the direction of the sensor (7) in step 2), the location of the sensor (7) relative 
to the field generator (1). 

A method of determining the location and/or orientation of a field generator (7) relative to a plurality of field sensors 
(1 ) of known location, each field sensor (1 ) comprising a plurality of collocated field sensor elements (3), the gen- 
erator (7) being energised and a measurement being made at the field sensor elements (3) of the respective field 
generated by the generator (7), the method being characterised by the steps of: 

1) for each field sensor (1) calculating, from the measurements of the field generated at each of its sensor 
elements (3) and an estimate of the orientation of the generator (7), an estimate of the distance from that 
particular sensor (1 ) to the generator (7), and 

2) utilising the estimates of distance from step 1 ), and the known location of the field sensors (1 ) to calculate 
an estimate of the location of the generator (7); 

3) employing the estimated location of the generator (7) from step 2) and the measurements of the field at the 
sensors ( 1 ) to calculate a new estimate of the orientation of the generator (7); 

4) repeating steps 1) to 3) iteratively, with step 1) employing the new estimate of generator orientation from 
the preceding step 3), to improve the estimates of location and orientation of the generator (7). 

Apparatus for determining the location and/or orientation of a field sensor (7) comprising: 

a plurality of field generators (1) each comprising a plurality of collocated field generating elements (3), 
energising means (5) operable for each field generator (1) to energise each of the plurality of field generating 
elements (3) to produce a field within which the location and orientation of the sensor (7) may be determined, 
measurement means (8), connected to the field sensor (7), to measure and output a parameter of the field at 
the sensor (7), and 

control means (6) to control the energising means (5), the control means (6) comprising storing means to store 
parameters output by the measurement means (8), and calculating means to calculate, from the stored meas- 
urements of the fields, the location and orientation of the sensor (7), 
the apparatus being characterised in that the calculating means comprises: 

location estimating means being operable to calculate, from the stored measurements of the fields and 
an estimate of the orientation of the sensor (7), an estimate of the distance of the sensor (7) from each 
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of the field generators (1) and, using the estimates of distance and the known location of the field gener- 
ators (1), to calculate an estimate of the location of the sensor (7); 

orientation estimating means being operable to calculate, from the estimate of sensor location by the 
location estimating means and the stored measurements of the field, a new estimate of the orientation of 
the sensor (7); 

means to iteratively improve the estimate of the location and orientation of the sensor (7), which means 
in use repeatedly employ the location and orientation estimating means in sequence, wherein the output 
of the orientation estimating means is adopted by the location estimating means as the new estimate of 
sensor orientation at each iteration. 



10 



9. Apparatus for determining the location of a field sensor (7) as claimed in claim 8, wherein the field sensor (7) 
comprises a single field sensing element and the parameter of the field sensed by said single field sensing element 
is dependent on the orientation of the field sensing element within the field. 

is 10. Apparatus for determining the location of a field sensor (7) as claimed in claim 8 or claim 9, having three field 
generators (1), each comprising three mutually orthogonal collocated field generating elements (3). 

11. Apparatus for determining the location of an object relative to a field generator (1 ), the apparatus comprising 

20 a field generator (1 ) comprising a plurality of field generating elements (3), 

energising means (5) to sequentially energise each of the field generating elements (3) to produce a field 
within which the object may be located, 

a sensor (7), to be attached to the object, comprising a plurality of collocated field sensing elements (A.B.C), 
each able to sense a parameter of the field, ; 
25 measurement means (8) to measure and outputthe parameter of the field sensed by each field sensing element 

(A,B,C) when each field generating element (3) is energised, and 

control means (6) to control the energising means (5), store the parameters output by the measurement means 
(8) and calculate the location of the sensor (7), relative to the field generator (1 ), 
the apparatus being characterised in that the control means (6) comprises 

30 weighting means to weight each of the parameters, sensed by the sensor {7\ by a direction dependent weight- 

ing factor for each field generating element (3), so that the calculated field strength B is equal to the field 
strength B that would exist at the sensor (7) if the axis of the field were directed towards the sensor (7), 
means to iteratively alter the direction dependent weighting factors until a maximum value of the field strength 
is found, and to determine the direction of the sensor (7) from the field generator (1) to a desired level of 

55 accuracy, and 

calculating means to calculate the distance of the sensor (7) from the generator (1) and hence the location of 
the sensor (7) relative to the generator (1). 

12. Apparatus for determining the location of an object as claimed in claim 11 , wherein the field generator (1 ) comprises 
40 three mutually orthogonal field generating elements (3) and the sensor (7) comprises three mutually orthogonal 

field sensing elements (A.B.C). 

13. Apparatus as claimed in any one of claims 8 to 12, arranged for use in surgery, therapy or diagnosis of a human 
or animal body. 

45 

14. An endoscopy system for use in the endoscopy of a human or animal body, the endoscopy system comprising 
apparatus as claimed in any one of claims 8 to 12. 

15. Apparatus for monitoring the position of an endoscope within a human or animal body, the apparatus comprising 
50 a field sensor (7), 

a plurality of field generators (1) each comprising a plurality of field generating elements (3), 
energising means (5) operable for each field generator (1) to energise each of the plurality of field generating 
elements (3) to produce a field within which the location of the endoscope may be determined, 
55 measurement means (8), connected to the field sensor (7), to measure and output a parameter of the field at 

the sensor (7), and 

control means (6) to control the energising means (5), store parameters output by the measurement means 
(8), and calculate the location of the sensor (7) relative to the plurality of field generators (1), the apparatus 
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being characterised in that the control means (6) are arranged to calculate thelocation of the sensor (7) relative 
to the plurality of field generators (1 ) by the method as claimed in any one of claims 1 to 7. 

16. Apparatus for determining the location and/or orientation of a sensor (7) as claimed in any one of claims 8, 9 or 
5 1 0, wherein one or more of said sensors (7) are attached to parts of a glove, the output of said apparatus providing 

data defining the location and orientation of the respective parts of a glove wearer's hand. 

17. Apparatus as claimed in claim 16, wherein one or more sensors (7) are attached to fingers of the glove. 

10 

Patentanspruche 

Verfahren zum Bestimmen des Ortes und/oder der Orientierung eines Feldsensors (7) relativ zu mehreren Felcl- 
erzeugern (1) an bekannten Orten, wobei jeder Felderzeuger (1) mehrere zusammengestellte felderzeugende 
Elemente (3) enthalt, wobei jedes erzeugende Element (3) eingeschaltet wird und bei dem Feldsensor (7) eine 
Messung des jeweiligen durch das erzeugende Element (3) erzeugten Feldes ausgefuhrt wird, wobei das verfahren 
gekennzeichnet ist durch die folgenden Schritte: 

1) fur jeden Felderzeuger (1) Berechnen einer Abschatzung der Entfernung von jenem besonderen Felder- 
zeuger (1 ) zu dem Sensor (7) aus den Messungen des durch jedes seiner erzeugenden Elemente (3) erzeug- 
ten Feldes und einer Abschatzung der Orientierung des Sensors (7), und 

2) Verwenden der Entfernungsabschatzungen aus Schritt 1 ) und des bekannten Ortes des Felderzeugers (1 ) 
zum Berechnen einer Abschatzung des Ortes des Sensors (7); 

3) Verwenden des abgeschatzten Ortes des Sensors (7) aus Schritt 2) und der Messungen des Feldes bei 
dem Sensor (7) zum Berechnen einer neuen Abschatzung der Orientierung des Sensors (7); 

4) iteratives Wiederholen der Schritte 1 ) bis 3) unter Verwendung der neuen Abschatzung der Sensororien- 
tierung aus dem vorausgehenden Schritt 3) in Schritt 1) zum Verbessern der Abschatzungen des Ortes und 
der Orientierung des Sensors (7). 

Verfahren nach Anspruch 1, bei dem jedes erzeugende Element (3) jedes Felderzeugers (1) sequentiell einge- 
schaltet wird, so da(3 zu irgendeinergegebenen Zeit nur ein erzeugendes Element (3) eingeschaltet ist. 

Verfahren nach Anspruch 1, bei demzumindest zwei erzeugende Elemente (3) gleichzeitig eingeschaltet werden, 
wobei jedes dieser zwei erzeugenden Elemente (3) bei einer von dem (den) anderen gleichzeitig eingeschalteten 
erzeugenden Element(en) (3) verschiedenen Frequenz eingeschaltet wird. 

Verfahren nach Anspruch 1 , bei dem im Schritt 3) der in Schritt 2) berechnete geschatzte Ort des Sensors (7).und 
die Messungen des Feldes bei dem Sensor (7) verwendet werden, urn fur jeden Felderzeuger (1) die Richtung 
des jeweiligen Feldes bei dem Sensor (7) zu berechnen und aus diesen Feldrichtungen eine neue Abschatzung 
der Orientierung des Sensors (7) zu berechnen. 

Verfahren nach Anspruch 1 oder Anspruch 4, bei dem bei Schritt 1 ) als Anfangsabschatzung der Orientierung des 
Sensors (7) die durch die unmittelbar vorausgehende Anwendung des Verfahrens berechnete Orientierung ge- 
nommen wird oder, falls dies die erste Anwendung des Verfahrens ist, die Achse des Sensors (7) anfangs als zum 
entsprechenden Felderzeuger (1) gerichtet angenommen wird. 

Verfahren zum Bestimmen des Ortes eines Feldsensors (7) mit mehreren relativ zu einem Felderzeuger (1) zu- 
sammengestellten Feldsensorelementen (A, B, C)mit mehreren zusammengestellten felderzeugenden Elementen 
(3), wobei jedes felderzeugende Element (3) der Reihe nach eingeschaltet wird und der Wert der resultierenden 
Feldstarke bei dem Feldsensor (7) gemessen wird, wobei die gemessene Feldstarke von dem Ort des Sensors 
(7) innerhalb des jeweiligen Feldes abhangt, wobei das Verfahren gekennzeichnet ist durch die folgenden Schritte: 

1 ) Berechnen eines richtungsabhangigen Gewichtungsfaktors fur jedes felderzeugende Element (3), sodaG 
die berechnete Feldstarke B gleich der Feldstarke B ist, die bei dem Sensor (7) vorhanden ware, wenn die 
Achse des Feldes zum Sensor (7) gerichtet ware, unter Verwendung aller Werte der gemessenen Feldstarke 
und einer Abschatzung der Richtung des Sensors (7) von dem Felderzeuger (1 ), 

2) iteratives Andern der richtungsabhangigen Gewichtungsfaktoren, urn B zu maximieren und daherdie Rich- 
tung des Sensors (7) von dem Felderzeuger (1 ) bis zu einem gewunschten Genauigkeitsgrad zu bestimmen, 
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und 

3) Verwenden der gemessenen Werte der Feldstarke zum Berechnen der Entfernung des Sensors (7) von 
dem Felderzeuger (1) und daher aus der Richtung des Sensors (7) in Schritt 2) des Ortes des Sensors (7) 
relativ zu dem Felderzeuger (1). 

5 

7. Verfahren zum Bestimmen des Ortes und/oder der Orientierung eines Felderzeugers (7) relativ zu mehreren Feld- 
sensoren (1) an bekannten Orten, wobei jeder Feldsensor (1) mehrere zusammengestellte Feldsensorelemente 
(3) enthalt, wobei der Generator (7) eingeschaltet wird und wobei eine Messung des jeweiligen durch den Erzeuger 
(7) erzeugten Feldes bei den Feldsensorelementen (3) ausgefuhrt wird, wobei das verfahren gekennzeichnet ist 

10 durch die folgenden Schritte: 

. 1 ) f Or jeden Feldsensor (1 ) Berechnen einer Abschatzung der Entfernung von jenem besonderen Sensor (1 ) 
zu dem Erzeuger (7) aus den Messungen des bei jedem seiner Sensorelemente (3) erzeugten Feldes und 
einer Abschatzung der Orientierung des Generators (7), und 
15 2) Verwenden der Abschatzungen der Entfernung aus Schritt 1 ) und des bekannten Ortes des Feldsensors 

(1) zum Berechnen einer Abschatzung des Ortes des Generators (7); 

3) Verwenden des geschatzten Ortes des Erzeugers (7) aus Schritt 2) und der Messungen des Feldes bei 
den Sensoren (1) zum Berechnen einer neuen Abschatzung der Orientierung des Erzeugers (7); 

4) iteratives Wiederholen der Schritte 1) bis 3), wobei in Schritt 1) zum Verbessern der Abschatzungen des 
20 Ortes und der Orientierung des Erzeugers (7) die neue Abschatzung der Orientierung des E rzeugers von dem 

vorausgehenden Schritt 3) verwendet wird. 

8. Vorrichtung zum Bestimmen des Ortes und/oder der Orientierung eines Feldsensors (7), mit: 

25 mehreren Felderzeugern (1 ), wobei jeder mehrere zusammengestellte felderzeugende Elemente (3) enthalt, 

einer Einschaltein richtung (5), die fur jeden Felderzeuger (1) so betrieben werden kann, daB sie mehrere 
felderzeugende Elemente (3) zum Erzeugen eines Feldes, innerhalb dessen der Ort und die Orientierung des 
Sensors (7) bestimmt werden konnen, einschalten kann, 

einer an den Feldsensor (7) angeschlossenen MeBeinrichtung (8) zum Messen und Ausgeben eines Para- 
mo meters des Feldes bei dem Sensor (7), und 

einer Steuereinrichtung (6) zum Steuern der Einschalteinrichtung (5), wobei die Steuereinrichtung (6) eine 
Speicherein richtung zum Speichern von durch die MeBeinrichtung (8) ausgegebenen Parametern und eine 
Recheneinrichtung zum Berechnen des Ortes und der Orientierung des Sensors (7) aus den gespeicherten. 
Messungen des Feldes enthalten, 
35 wobei die Vorrichtung dadurch gekennzeichnet ist, daB die Recheneinrichtung folgendes enthalt: 

eine Ortsabschatzungseinrichtung, die so betrieben werden kann, daB sie aus den gespeicherten Messungen 
der Felder und einer Abschatzung der Orientierung des Sensors (7) eine Abschatzung der Entfernung des 
Sensors (7) von jedem Felderzeuger (1 ) berechnen kann und unter Verwendung der Abschatzungen der Ent- 
fernung und des bekannten Ortes des Felderzeugers (1) eine Abschatzung des Ortes des Sensors (7) be- 
40 rechnen kann; 

eineOrientierungsabschatzungseinrichtung, die so betrieben werden kann, daB sie aus der Abschatzung des 
Sensorortes durch die Ortsabschatzungseinrichtung und die gespeicherten Messungen des Feldes eine neue 
Abschatzung der Orientierung des Sensors (7) berechnen kann; 

eine Einrichtung zum iterativen Verbessern der Abschatzung des Ortes und der Orientierung des Sensors (7), 
45 wobei diese Einrichtung beim Gebrauch wiederholt sequentiell die Orts- und Orientierungsabschatzungsein- 

richtung verwendet, bei dem die AusgangsgroGen der Orientierungsabschatzungseinrichtung bei jeder Itera- 
tion von der Ortsabschatzungseinrichtung als die neue Abschatzung der Sensororientierung verwendet wer- 
den. 



so 9. Vorrichtung zum Bestimmen des Ortes eines Feldsensors (7) nach Anspruch 8, bei dem der Feldsensor (7) ein 
einzelnes Feldsensorelement enthalt und bei dem der durch das einzelne Feldsensorelement abgetastete Para- 
meter des Feldes von der Orientierung des Feldsensorelements innerhalb des Feldes abhangt, 

10. Vorrichtung zum Bestimmen des Ortes eines Feldsensors (7) nach Anspruch 8 Oder Anspruch 9 mit drei Felder- 
55 zeugern (1), von denen jeder drei zueinander orthogonale zusammengestellte felderzeugende Elemente (3) ent- 
halt 

11. Vorrichtung zum Bestimmen des Ortes eines Objekts relativ zu einem Felderzeuger (1), wobei die Vorrichtung 
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enthalt: 

einen Felderzeuger (1) mil mehreren felderzeugenden Elementen (3), 

eine Einschafteinrichtung (5) zum sequentiellen Einschalten jedes der felderzeugenden Elemente (3) zum 
Erzeugen eines Feldes, innerhalb dessen das Objekt lokalisiert werden kann, 

einen an dem Objekt anzubringenden Sensor (7) mit mehreren zusammengestellten Feldsensorelementen 
(A, B, C), die jeweils einen Parameter des Feldes abtasten konnen, 

eine MeBeinrichtung (8) zum Messen und Ausgeben des Parameters des durch jedes Feldsensorelement (A, 
B, C) abgetasteten Feldes, wenn jedes felderzeugende Element (3) eingeschaltet ist, und 
eine Steuereinrichtung (6) zum Steuern der Einschalteinrichtung (5), zum Speichern der durch die MeBein- 
richtung (6) ausgegebenen Parameter und zum Berechnen des Ortes des Sensors (7) reiativ zu dem Felder- 
zeuger (1), 

wobei die Vorrichtung dadurch gekennzeichnet ist, daB die Steuereinrichtung (6) enthalt: 

eine Gewichtungseinrichtung zum Gewichten jedes der von dem Sensor (7) abgetasteten Parameter durch 
einen richtungsabhangigen Gewichtungsfaktor f ur jedes felderzeugende Element (3), so daB die berechnete 
Feldstarke B gleich der Feldstarke B ist, die bei dem Sensor (7) existieren wurde, falls die Achse des Feldes 
zum Sensor (7) gerichtet ware, 

eine Einrichtung zum iterativen Andern der richtungsabhangigen Gewichtungsfaktoren, bis ein Maximalwert 
der Feldstarke gef unden ist, und zum Bestimmen der Richtung des Sensors (7) von dem Felderzeuger (1 ) bis 
zu einem gewunschten Genauigkeitsgrad, und 

eine Rechene in richtung zum Berechnen der Entfernung des Sensors (7) von dem Erzeuger (1 ) und daher des 
Ortes des Sensors (7) reiativ zu dem Erzeuger (1 ). ? 

12. Vorrichtung zum Bestimmen des Ortes eines Objekts nach Anspruch 11 , bei dem der Felderzeuger (1 ) drei zuein- 
ander orthogonale felderzeugende Elemente (3) enthalt und der Sensor (7) drei zueinander orthogonale Feldsen- 
soreiemente (A, B, C) enthalt. 

13. Vorrichtung nach irgendeinem der Anspruche 8 bis 12, die so beschaffen ist, dad sie in der Chirurgie, Therapie 
oder Diagnose eines menschlichen oder tierischen Korpers verwendet wird. 

14. Endoskopiesystem zur Verwendung in der Endoskopie eines menschlichen oder tierischen Korpers, wobei das 
Endoskopiesystem eine in irgendeinem der Anspruche 8 bis 12 beanspruchte vorrichtung enthalt. 

15. Vorrichtung zum Uberwachen des Ortes eines Endoskops innerhalb eines menschlichen oder tierischen Korpers, 
wobei die Vorrichtung versehen ist mit einem Feldsensor (7), 

mehreren Felderzeuger (1), wovon jeder mehrere felderzeugende Elemente (3) enthalt, 
einer Einschalteinrichtung (5), die fur jeden Felderzeuger (1) so betrieben werden kann, daB sie jedes der 
mehreren felderzeugenden Elemente (3) zum Erzeugen eines Feldes, innerhalb dessen der Ort des Endo- 
skops bestimmt werden kann, einschalten kann, 

einer an den Feldsensor (7) angeschlossenen MeBeinrichtung (8) zum Messen und Ausgeben eines Para- 
meters des Feldes bei dem Sensor (7), und 

einer Steuereinrichtung (6) zum Steuern der Einschalteinrichtung (5), zum Speichern der durch die MeBein- 
richtung (8) ausgegebenen Parameter und zum Berechnen des Ortes des Sensors (7) reiativ zu den mehreren 
Felderzeugern (1), wobei die Vorrichtung dadurch gekennzeichnet ist, daB die Steuereinrichtung (6) so be- 
schaffen ist, daB sie den Ort des Sensors (7) reiativ zu den mehreren Felderzeugern (1 ) mit dem in irgendeinem 
der Anspruche 1 bis 7 beanspruchten Verfahren berechnet. 

16. Vorrichtung zum Bestimmen des Ortes und/oder der Orientierung eines Sensors (7) nach irgendeinem der An- 
spruche 8, 9 oder 10, bei dem einer oder mehrere der Sensoren (7) an Teilen eines Handschuhs befestigt sind, 
wobei der Ausgang der Vorrichtung Daten bereitstelft, die den Ort und die Orientierung der jeweiligen Teile der 
Hand eines Tragers des Handschuhs definieren. 

17. Vorrichtung nach Anspruch 16, bei dem einer oder mehrere Sensoren (7) an Fingern des Handschuhs befestigt 
sind. 
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Revendications 

1. Precede de determination de la localisation et/ou de I'orientation d'un capteur de champ (7) par rapport k une 
plurality de generateurs de champ (1) de localisation connue, chaque generateur de champ (1) comprenant une 
s pluralite d'eiements de generation de champ situ6s au meme emplacement (3), chaque element de generation 

(3) etant active et une mesure etant faite au niveau du capteur de champ (7) du champ respectif gener6 par 
l'6lement de generation (3). le precede etant caracterise par les etapes consistant a : 

1) pour chaque g6n6rateur de champ (1), calculer k partir des mesures du champ g6ner6 par chacun de ses 
10 elements de generation (3) et d'une estimation de I'orientation du capteur (7), une estimation de la distance 

entre ce gen6rateur de champ particulier (1 ) et le capteur (7), et 

2) utiliser les estimations de la distance provenant de I'etape 1), et la localisation connue des generateurs de 
champ (1) pour calculer une estimation de la localisation du capteur (7), 

3) utiliser la localisation estimee du capteur (7) provenant de I'etape 2) et les mesures du champ au niveau 
15 du capteur (7) pour calculer une nouvelle estimation de I'orientation du capteur (7), 

4) repeter les etapes 1) a 3) de facon iterative, retape 1) utilisant la nouvelle estimation de i'orientation du 
capteur provenant de I'etape pr6c6dente 3), afin d'ameiiorer les estimations de la localisation et de I'orientation 
du capteur (7). 

20 2. Procede selon la revendication 1 , dans lequei chaque element de generation (3) de chaque generateur de champ 

(1 ) est active en sequence de sorte qu'un seul element de generation (3) est active a. un instant donn6. 

3. Procede selon la revendication 1, dans lequei au moins deux elements de generation (3) sont actives simultan6- 
ment, chacun de ces au moins deux elements de generation (3) etant active a. une frequence diff6rente de tfautre 

25 ou des autres elements de generation actives simultan6ment (3). 

4. Procede selon la revendication 1 , dans lequei a I'etape (3), la localisation estimee du capteur (7) caicutee a I'etape 

(2) et les mesures du champ au niveau du capteur (7) sont utilisees pour calculer, pour chaque generateur de 
champ (1 ), la direction du champ respectif au niveau du capteur (7) et, S partir de ces directions de champ, calculer 

30 une nouvelle estimation de I'orientation du capteur (7). 

5. Proc6de selon la revendication 1 ou la revendication 4, dans lequei a I'etape (1 ), Pestimation initials de I'orientation 
du capteur (7) est prise comme etant I'orientation qui a 6t6 calcuiee par I'application imm6diatement prec6dente 
du procede ou, s'il s'agit de la premiere application du procede, Faxe du capteur (7) est suppose initialement dtre 

3S oriente en direction du g6nerateur de champ respectif (1 ). 

6. Proc6d6 de determination de la localisation d'un capteur de champ (7), comprenant une pluralite d'6iements de 
detection de champ situ6s au meme emplacement (A, B, C) par rapport k un generateur de champ (1 ) comprenant 
une pluralite d'eiements de generation de champ situes au meme emplacement (3), chaque 6l6ment de generation 

40 de champ (3) etant active tour a tour et la valeur de I'intensite du champ resultant etant mesur6e au niveau du 

capteur de champ (7), I'intensite du champ mesur6e etant d6pendante de la localisation du capteur (7) & I'int6rieur 
du champ respectif, le procede etant caracterise par les etapes consistant & : 

1 ) calculer, en utilisant toutes les valeurs d'intensite de champ mesurees et une estimation de la direction du 
45 capteur (7) par rapport au generateur de champ (1 ), un facteur de ponderation dependant de la direction pour 

chaque element de generation de champ (3) de sorte que I'intensite de champ calcuiee B sort 6gale & I'intensite 
du champ B qui existerait au niveau du capteur (7) si I'axe du champ etait oriente en direction du capteur (7), 

2) modifier de facon iterative les facteurs de pond6ration dependant de la direction afin de maximiser B et de 
determiner ainsi avec un niveau desire de precision la direction du capteur (7) par rapport au generateur de 

50 champ (1), et 

3) utiliser les valeurs mesurees de I'intensite du champ pour calculer la distance du capteur (7) par rapport 
au generateur de champ (1) et de ce fait, & partir de la direction du capteur (7) de I'etape 2), la localisation du 
capteur (7) par rapport au generateur de champ (1 ). 

55 7. Proc6d6 de determination de la localisation et/ou de I'orientation d'un generate ur~de champ (7) par rapport d une 
pluralite de capteurs de champ (1 ) de localisation connue, chaque capteur de champ (1 ) comprenant une pluralite 
d'eiements de capteur de champ situes au meme emplacement (3), le generateur (7) etant active et une mesure 
etant faite au niveau des elements de capteur de champ (3) du champ respectif g6n6r6 par le generateur (7), le 
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precede etant caracte rise par les etapes consistant a : 

1 ) pour chaque capteur de champ (1), calculer a partir des mesures du champ gen6r6 au niveau de chacun 
de ses elements de capteur (3) et d'une estimation de Pqrientation du generateur (7), une estimation de la 

s distance entre ce capteur particulier(1 ) et le generateur (7), et 

2) utiliser les estimations de distance provenant de I'etape 1 ), et la localisation connue des capteurs de champ 
(1) pour calculer une estimation de la localisation du generateur (7), 

3) utiliser la localisation estimee du generateur (7) provenant de Tetape 2) et les mesures du champ au niveau 
des capteurs (1 ) pour calculer une nouvelle estimation de I'orientation du gen6rateur (7), 

io 4) repeter les etapes 1) a 3) de fa^on iterative, I'etape 1) utilisant la nouvelle estimation de ('orientation du 

generateur provenant de I'etape precedente 3), af in d'ameliorer les estimations de la localisation et de Porien- 
, tation du generateur (7). 

8. Dispositif destine a determiner la localisation et/ou Porientation d'un capteur de champ (7) comprenant : 

is 

une plurality de generateurs de champ (1) comprenant chacun une plurality d'elements de generation de 
champ situes au meme emplacement (3), 

un moyen d'activation (5) pouvant etre mis en oeuvre pour chaque generateur de champ (1) afin d'activer 
chacun de la plurality des elements de generation de champ (3) de maniere a produire un champ a Pinterieur 
20 duquel la localisation et I'orientation du capteur (7) peuvent etre d6termin6es, 

un moyen de mesure (8), relie au capteur de champ (7), afin de mesurer et de fournir en sortie un parametre 
du champ au niveau du capteur (7), et 

un moyen de commande (6) afin de commander le moyen d'activation (5), te moyen de commande (6) com- 
prenant un moyen de memorisation destine* a memoriser des parametres fournis en sortie par le moyen de 
25 mesure (8), et un moyen de calcul destine a calculer, a partir des mesures m6moris6es des champs, la loca- 

lisation et I'orientation du capteur (7), le dispositif etant caracteris6 en ce que le moyen de calcul comprend : 

un moyen d'estimation de localisation qui peut etre mis en oeuvre pour calculer, a partir des mesures 
memorisees des champs et d'une estimation de ('orientation du capteur (7), une estimation de la distance 
30 du capteur (7) par rapport a chacun des generateurs de champ (1 ) et, en utilisant les estimations de 

distance et la localisation connue des generateurs de champ (1), calculer une estimation de la localisation 
du capteur (7), 

un moyen d'estimation d'orientation qui peut etre mis en oeuvre pour calculer, a partir de I'estimation de 
la localisation du capteur par le moyen d'estimation de localisation et des mesures memorisees du champ, 

35 une nouvelle estimation de i'orientation du capteur (7), 

un moyen destine a ameliorer de facon iterative I'estimation de la localisation et de I'orientation du capteur 
(7), lequel moyen, en utilisation, utilise de facon repetitive les moyens d'estimation de localisation et 
d'orientation en sequence, dans lequel ia sortie du moyen d'estimation d'orientation est adoptee par le 
moyen d'estimation de localisation en tant que nouvelle estimation de I'orientation du capteur a chaque 

40 iteration. 

9. Dispositif destine a determiner la localisation d'un capteur de champ (7) selon la revendication 8, dans lequel le 
capteur de champ (7) comprend un element de detection de champ unique et le parametre du champ detect6 par 
ledit element de detection de champ unique depend de I'orientation de ('element de defection de champ a Pinterieur 

<5 du champ. 

1 0. Dispositif destin6 a determiner la localisation d'un capteur de champ (7) selon la revendication 8 ou la revendication 
9, comportant trois generateurs de champ (1), chacun comprenant trois elements de generation de champ situ6s 
au meme emplacement mutueilement orthogonaux (3). 

so 

11. Dispositif destine a determiner la localisation d'un objet par rapport a un g6n6rateur de champ (1), le dispositif 
comprenant 

un generateur de champ (1) comprenant une plurality d'eiements de generation de champ (3), 
55 un moyen d'activation (5) destine a activer sequentiellement chacun des elements de generation de champ 

(3) afin de produire un champ a Pinterieur duquel Pobjet peut etre localise, 

un capteur (7), destine a etre fixe a Pobjet, comprenant une plurality d'eiements de detection de champ situes 
au meme emplacement (A, B, C), chacun pouvant detecter un parametre du champ, 
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un moyen de mesure (8) destine a mesurer et a fournir en sortie le parametre du champ detecte par chaque 
Element de detection de champ (A, B, C) lorsque chaque element de generation de champ (3) est active, et 
un moyen de commande (6) destine a commander le moyen d'activation (5), a m6moriser les parametres 
foumis en sortie par le moyen de mesure (8) et a calculer la localisation du capteur (7)..par rapport au genS- 
5 rateur de champ (1), 

le dispositit etant caracteris6 en ce que le moyen de commande (6) comprend 

un moyen de ponderation destine* a ponderer chacun des parametres, detected par le capteur (7), par un 
facteur de ponderation dependant de la direction pour chaque element de generation de champ (3), de sorte 
que I'intensit6 calcuiee du champ B soit 6gale a Nntensite du champ B qui existerait au niveau du capteur (7) 
*o si I'axe du champ etait orients en direction du capteur (7), 

un moyen destine* a modifier de facon iterative les facteurs de ponderation dependants de la direction jusqu'a 
. ce qu'une valeur maximum de I'intensite du champ soit trouv6e, et a determiner la direction du capteur (7) par 
rapport au g6n6rateur de champ (1) avec un niveau desire de precision, et 

un moyen de calcul destine a calculer la distance du capteur (7) par rapport au generateur (1 ) et de ce fait la 
* 5 localisation du capteur (7) par rapport au generateur (1 ). 

12. Dispositif destine a determiner la localisation d'un objet selon la revendication 11, dans lequel le generateur de 
champ (1 ) comprend trois elements de generation de champ mutuellement orthogonaux (3) et le capteur (7) com- 
prend trois elements de detection de champ mutuellement orthogonaux (A, B, C). 

20 

13. Dispositif selon Tune quelconque des revendications 8 a 12, agence pour une utilisation en chirurgie, th6rapie ou 
diagnostic d'un corps humain ou animal. 

14. Systeme d'endoscopie destine a etre utilise lors de i'endoscopie d'un corps humain ou animal, le systeme d'en- 
25 doscopie comprenant un dispositif selon I'une quelconque des revendications 8 a 1 2. 

15. Dispositif destine a controler la position d'un endoscope a Tinterieur d'un corps humain ou animal, le dispositif 
comprenant un capteur de champ (7), 

30 une pluralite de generateurs de champ (1) comprenant chacun une plurality d'eiements de generation de 

champ (3), 

un moyen d'activation (5) pouvant etre mis en oeuvre pour chaque generateur de champ (1) afin d'activer 
chacun de la pluralite des elements de generation de champ (3) de maniere a produire un champ a I'interieur 
duquel la localisation de Pendoscope peut §tre determinee, 
35 un moyen de mesure (8) relie au capteur de champ (7), afin de mesurer et de fournir en sortie un parametre 

du champ au niveau du capteur (7), et 

un moyen de commande (6) destine a commander le moyen d'activation (5), m6moriser les parametres foumis 
en sortie par le- moyen de mesure (8), et calculer ia localisation du capteur (7) par rapport a la pluralite des 
generateurs de champ (1 ), le dispositif etant caracteris6 en ce que le moyen de commande (6) est agence 
40 pour calculer la localisation du capteur (7) par rapport a la pluralite des generateurs de champ (1) grace au 

proc6d6 selon Tune quelconque des revendications 1 a 7. 

16. Dispositif destine a determiner la localisation et/ou "'orientation d'un capteur (7) selon I'une quelconque des re- 
vendications 8, 9 ou 10, dans lequel un ou plusieurs desdits capteurs (7) sont fixes a des parties d'un gant, la 

45 sortie dudit dispositif procurant des donnees qui definissent la localisation et I'orientation des diverses parties de 

la main du porteur du gant. 

17. Dispositif selon la revendication 16, dans lequel un ou plusieurs capteurs (7) sont fix6s aux doigts du gant. 

so 
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| Fig.2. z 
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Fig. 5. 
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Fig. 7. 
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Fig. 8. 
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Fig . 12 
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